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To  establish  the  groundwork  for  estimating  circular  motion  from 
sonar  measurements,  necessary  and  sufficient  conditions  for  the  ex¬ 
istence  and  uniqueness  of  a  motion  parameter  solution  are  derived. 
The  measurements,  range,  range  rate,  and  bearing,  for  a  point  on  a 
moving  object,  are  assumed  to  be  matched  [II.  ie  associated  with 
measurements  of  the  same  point  at  a  later  time.  These  six  measure¬ 
ments;  R  i.  B\ ,  and  B-_:  subscripted  to  denote  time,  are 

used  to  estimate  five  parameters  of  planar  motion:  initjU  position, 
*i.  j»u  speed.  V\  initial  heading,  Hu  and  heading  rate.  at.  The  range 
and  bearing  measurements  are  transformed  to  initial  position  and 
(equivalent)  straight  line  travel  distance,  D  ,  and  direction,  o,  using 


Xi=R,cosfl,  yi  =  R,smfli 

Xi  =  RicosRi  jri  =  RjSinSr 

D  0  =  tan~:[ . 

Substituting  p  *  re T/2,  gi,  =  0-  B ,.  and  =  a  -  fl,  leaves  three  meas¬ 
urement  equations. 

D  =V  T  sap  Ip  (1) 

R,  =  Vcos(>jr, -p)  (2) 

Ri  =  V  casino  +p)  (3) 

in  two  unknowns,  v  and  p .  Once  a  solution  for  p  is  found  the  initial 
heading  is  given  by  H ,  =  e  -  p .  Assume  V  >  0  and  -it  <  p  <  it  to 
limit  the  number  of  solutions.  The  variable  V  can  be  eliminated  by 
combining  equations  (1)  and  (2)  to  give 

~  =  costy, -p)  (4) 

with  p  the  only  nonmeasured  quanicy.  Dividing  by  R,  is  for  con¬ 
venience  and  can  be  shown  to  not  alter  results  when  R,  =0,  In  (4) 
the  ratio  D>T  is  assumed  positive  as  is  the  left  hand  side  of  (4)  for  the 
range  of  p  considered.  In  the  example  shown  in  Figure  1  a  solution 
of  (4)  exists  if  ihe  amplitude  of  the  sinusoid  is  negative  or  positive 
and  large  enough  for  a  tangential  intersection  with  the  sine  function. 
Using  the  equations  for  tangential  intersection  gives  the  condition  for 
existence  of  a  solution  of  (4)  (ie  consistency  of  R ,)  as 

-ySYiSy  (5a) 

-.tS  i(i,  S--?  .  4  Siy,  Sj  (5b) 

where  tbe  values  for  -Aoiyi).  which  is  symmetric  about  y,  =  0  and 
y,  =  rt,  are  tabulated  in  Table  l. 

If  (5)  is  met  with  equaJiry.  equation  (4)  has  a  unique  solution,  and 
the  solution  for  the  motion  parameters  is  unique  if 

>1=T^vTC0S(^*'’)  »> 

Otherwise  no  solution  for  the  motion  parameters  exists. 

If  (5)  is  met  with  inequality,  equation  (4)  has  two  solutions.  The 
consistency  of  (3)  is  more  easily  assessed  when  it  is  combined  with 
(2)  by  removing  V  to  give 

Rtcosip -f,)  =  R,cosO>  ■‘■ig^.  (7> 

Equation  (7)  can  have  two  solutions  for  p  that  differ  by  it  The 
sinusoid  of  equation  (2)  has  opposite  signs  at  these  two  solutions  and 
the  same  sign  at  both  solutions  of  (4).  Therefore  equations  (4)  and 
(7)  have  ai  most  one  solution  in  common.  For  consistency,  equation 
(6)  must  be  true  for  one  of  the  solutions  of  (4). 


a  > 

'  -  T 


Equation  (7)  can  also  be  true  for  ail  p  leading  to  an  ambiguity  u 


either 

B  *  5e 

¥l  *  +  2itn  Ri  =  Ri  -*♦  =  — L, — a.  +  xs 

(8-, 

or 

_  2  '  fil  +  3s  +  S 

tjh  »  -!|<i  ex-t-2.ee  R:  =  ~R,  ->  »  =  — 1 -  *  »- 

(O 

for  any  integer  n.  Eq.  (8).  physically  interpreted,  states  the  straight 
line  travel  is  along  the  line  of  sight.  (S,=fi;).  Equanon  (9)  is  satis¬ 
fied  when  the  observer  lies  on  the  perpendicular  bisector  of  the 
straight  line  travel.  It  is  also  satisfied  if  the  starting  and  ending  posi¬ 
tion,  (xiOMland (xej;),  are  on  opposite  sides  of  the  observer.  These 
geometries  cause  two-way  ambiguities  in  the  motion  parameter  solu¬ 
tions  unless  (5)  is  met  wuh  equality. 
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Figure  1.  Crash  of  ecuatlon  (4  )  shoving  0,  1 ,  and  2 
solution  esses  as  a  function  of  A. 


Figure  2.  Arcrgjces  trajectories  associated  with  (a)  ofcser-.-er 
on  perpendicular  htsertcr,  (h)  observer  outside  and  ctlurear 
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